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ABSTRACT 


The  Naval  Postgraduate  School  UAV  Laboratory  developed  a  Small 
Unmanned  Aerial  Vehicle  (SUAV)  equipped  with  a  Vision  Based  Target  Tracking 
(VBTT)  system  as  part  of  its  Tactical  Network  Topology  field  experimentation 
program.  The  VBTT  system  includes  a  miniaturized  gimbaled  camera  that  allows 
autonomous  target  tracking  while  providing  concurrent  estimates  of  target  motion 
including  its  position,  velocity  and  heading.  Using  the  current  control  law,  the 
speed  of  convergence  and  the  range-holding  performance  have  been  found  to 
deteriorate  as  target  speed  increases.  The  aim  of  this  thesis  is  to  elaborate  on 
the  existing  control  law  in  order  to  achieve  better  performance.  Employing  a  new 
and  novel  algorithm  from  the  Lyapunov  Stability  Analysis,  for  the  purpose  of 
adjusting  the  feedback  gain,  is  proposed  in  this  thesis;  to  that  end  a  control  law 
with  adjustable  gain  can  be  easily  implemented  based  on  UAV-Target  kinematics 
to  optimize  UAV  performance.  The  performance  of  the  newly  adjustable  gain 
control  law  is  tested  in  both  SIMULINK  model  and  Hardware-ln-the-Loop 
simulations  to  verify  any  improvement  in  performance  over  the  constant  gain 
control  law.  Principal  results  offer  improved  SUAV  target-tracking  performance 
with  no  additional  hardware  costs. 
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I.  INTRODUCTION 


A.  BACKGROUND 

The  proliferation  of  unmanned  system  technology  in  military  and 
homeland  security  applications  has  accelerated  in  the  past  decade.  The  success 
of  UAV  and  UGV  use  in  every  theatre  of  operations  further  cements  the 
significance  of  an  unmanned  system  technology  application  in  modern  warfare. 
During  the  1991  Gulf  War,  Unmanned  Aerial  Vehicles  (UAV)  were  deployed  as 
reconnaissance  units  which  sought  targets  for  naval  guns.  The  War  on  Terror  in 
Afghanistan  and  Iraq  has  seen  the  role  of  the  UAV  transition  from  a 
reconnaissance  vehicle  to  an  Unmanned  Combat  Air  Vehicle  where  the  UAV  is 
armed  with  Hellfire  missile  [1]. 

Unmanned  Ground  Vehicles  (UGV),  capable  of  combating  against 
Improvised  Explosive  Devices  (lEDs),  are  also  increasingly  deployed  in  Iraq  [2]. 
These  remote-controlled  ground  vehicles  have  the  ability  to  probe  dubious 
objects  and  detonate  any  suspected  lEDs.  Unmanned  aerial  vehicles  and 
unmanned  ground  vehicles  are,  therefore,  critical  assets  and  effective  force 
multipliers  in  today’s  battlefield  and  future  network-centric  warfare.  Due  to  the 
complementary  capabilities  of  the  UAV  and  UGV,  collaboration  of  both 
unmanned  systems  expands  the  tactical  capabilities  of  the  integrated  system  in 
order  to  execute  complex  missions. 

The  UGV  has  a  limited  Field-Of-View  (FOV)  and  this  leads  to  the  UGV 

being  less  responsive  to  threats  beyond  its  FOV;  however  with  its  aerial 

superiority,  the  UAV  has  a  superior  FOV.  By  incorporating  wireless 

communication  between  the  UAV  and  UGV,  the  UGV  is  able  to  utilize  the 

reconnaissance  information  provided  by  the  UAV  to  speed  up  the  UGV’s 

response  to  approaching  targets.  One  key  application  of  the  integration  of  both 

unmanned  platforms  is  the  ability  to  have  unmanned  force  protection  for  ground 

troops  operating  in  Iraq  and  Afghanistan  [3].  Ongoing  research  at  the  Naval 

1 


Postgraduate  School’s  (NPS)  Physics  Department  arms  the  UGV  with  shaped 
charges  that  can  incapacitate  soft  skin  vehicles  and  detonate  suspected  lEDs. 
Via  aerial  reconnaissance  with  onboard  sensors,  the  UAV  would  be  able  to 
detect  threats  such  as  armored  vehicles  or  anomalies  such  as  suspected 
insurgent  movements,  minefields  or  suspected  lEDs.  The  UAV  would  then 
dispatch  the  UGV  to  the  area  in  order  to  neutralize  the  threat. 

B.  PROBLEM  STATEMENT 

Many  large-scale  tactical  UAVs  have  evolved  towards  multi-role  and  multi¬ 
mission  platforms.  However  due  to  the  high  acquisition  cost,  a  limited  number  of 
UAVs  are  made  available  to  support  day-to-day  troop  operations  in  Iraq.  Driven 
by  technological  advancements  in  miniature  autopilots,  networking  and  robotics, 
a  low-cost  Small  UAV  (SUAV)  may  be  constructed  using  low  cost  Commercial- 
Off-the-Shelf  (COTS)  components  to  achieve  the  same  capabilities.  Therefore, 
the  collaboration  of  SUAV  and  UGV  offers  unmanned  force  protection  at  a  lower 
cost,  yet  provides  an  equally  effective  solution. 

The  NPS  UAV  laboratory  has  developed  a  SUAV  equipped  with  a  COTS 
Vision  Based  Target  Tracking  (VBTT)  system  as  part  of  the  Tactical  Network 
Topology  field  experiment  program.  The  VBTT  onboard  the  SUAV  includes  a 
miniaturized  gimbaled  camera  that  is  capable  of  autonomous  target  tracking.  The 
control  concept  of  the  SUAV  is  illustrated  in  Figure  1  below.  The  developed 
control  guarantees  that  the  SUAV  is  autonomously  guided  such  that  the  target 
remains  constantly  in  the  FOV  of  the  gimbaled  camera  [4],  This  results  in  two 
coordinated  motions:  SUAV  motion  relative  to  target  and  motion  of  gimbaled 
camera  relative  to  the  target.  Previous  research  has  already  addressed  the  issue 
of  devising  a  coordinated  camera  and  a  UAV  controlled  law.  The  control 
algorithm  for  both  gimbaled  camera  and  UAV  was  developed,  and  preliminary 
results  on  the  robustness  of  the  control  were  obtained  [5].  This  thesis 
concentrates  on  further  analysis  of  the  stability  bounds  for  the  case  of  actively 
moving  targets. 
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Figure  1 .  Illustration  of  Control  Algorithm  [From  4] 

C.  SCOPE 

Previous  thesis  research  showed  that  the  control  law  stated  below  in 
equation  (1)  showed  improved  robustness  and  efficiency.  However  for  constant 
feedback  gain,  the  speed  of  convergence  and  the  range  holding  performance 
deteriorate  as  vt/vg  increases.  Therefore,  the  objective  of  the  research  efforts  in 

this  thesis  is  to  elaborate  on  the  existing  control  law  in  order  to  improve  the 
performance  of  the  control  law  when  vt/vg  increases. 

V 

l// = -COST)- ktf  (1) 

Pd 

y/h  =  ktf  +  kzS 

77  =  Navigation  angle  error  y/  =  UAV  turn  rate  in  inertial  frame 

s  =  Line-of-sight  error  y/h  =  Camera  turn  rate  in  UAV  frame 

=  SUAV  ground  speed  pd  =  Desired  range 

kx,k2  =  Gain  constants 
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Since  constant  value  for  Gain  parameters  has  performance  limitations, 
this  thesis  aims  to  improve  the  performance  of  the  control  law  by  using  an 
adjustable  gain  that  factors  UAV  and  target  kinematics  into  the  control  law.  The 
scope  of  work  in  this  thesis  includes  testing  the  performance  of  adjustable  gain 
over  constant  gain. 

D.  THESIS  OUTLINE 

In  Chapter  II,  it  is  shown  how  the  feedback  control  gain  is  derived  from  the 
Lyapunov  Stability  analysis  that  guarantees  a  bounded  solution.  It  is  also  shown 
how  adjustable  gain  vadj  for  the  UAV  guidance  varies  with  UAV  and  target 

kinematics,  namely  v  ,  vt  and  pd.  The  adjustable  gain  can  be  chosen  to  extend 
the  region  of  attraction.  Consequently  the  dynamics  of  vadj  as  a  function  of  v  ,  vt 
and  pd  are  analyzed. 

Chapter  III  illustrates  the  implementation  of  the  control  algorithm  with 
adjustable  gain  in  both  the  SIMULINK  model  of  the  SUAV  and  the  Hardware-ln- 
the-Loop  (HIL)  simulation.  The  objective  of  running  the  SIMULINK  model  is  to 
predict  the  performance  of  the  newly  developed  control  law  while  HIL  simulation 
validates  the  results  of  SIMULINK  model  for  physical  SUAV.  The  performance  of 
the  modified  control  algorithm  is  then  compared  with  the  previous  control 
algorithm  and  initial  results  of  5.  An  analysis  of  the  results  is  presented  in  this 
chapter. 

Chapter  IV  presents  the  conclusion  of  the  research  efforts  in  this  thesis 
and  recommendations  for  future  research. 


4 


II.  DEVELOPMENT  OF  CONTROL  LAW 


A.  SUAV  CONTROL  SYSTEM  MODEL 


Assuming  that  the  autopilot  module  is  capable  of  maintaining  the  UAV  at 
level  flight,  the  kinematics  model  for  the  UAV  and  target  may  be  simplified  into  a 
two-dimensional  problem.  The  two-dimensional  kinematics  model  is  shown  in 
Figure  2  below. 


r]  =  navigation  error  y/ 

£  = camera  LOS  Pan  error  y/_ 

X  _LOS  angle  in  inertia  frame  y/^ 

X..  =  LOS  vector  V,. 

Xr  -  Normal  to  LOS  vector  Vt 


-  UAV  heading  in  inertia  frame 
“Target  heading  ininertia  frame 

=  Camera  angle  in  UAV  body  frame 
=  SUAV  ground  speed  in  inertia  frame 

-  Target  ground  speed  in  inertia  frame 


Figure  2.  Simplified  2-D  UAV-target  kinematics  model  [From  5] 

It  is  shown  in  [4]  that  the  kinematics  of  the  tracking  problem  is  given  by 
equation  [2],  The  angles  r\  and  s  denote  the  UAV  guidance  error  and  Gimbaled 
camera  control  errors;  therefore,  the  control  objective  is  to  drive  r\  and  s  using  the 
UAV  turn  rate  y/  and  y/h  as  control  inputs. 
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(2) 


P 


By  applying  feedback  control  as  described  in  equation  (1)  to  the  two-d 
kinematics  model,  the  control  system  equations  are  given  in  equation  (3)1. 


V  =  -vgPe  cos0iPj)/Pj  ~  KVPd  +  v,pcos(iipd  -  y/r)/pd 


(3) 


Pe  =  p\  sinfe)-  v,  smfc  -  if/r  )p2 

e  =  vgpe  cos {f]Pd)~  ki£~vt  cos (riPd  -  ¥r  )p 

where  ^  represents  the  relative  heading  y/-y/t  with  respect  to  the  target. 

It  is  noted  [4]  that  Equation  (2)  may  be  separated  into  two  sub-systems. 
Sub-system  I: 


-VgPe cos (jlPd)/pd  ~  Km,  +  v//7cos(?7p,  -  yr)/pd 

p2vg  sin  (fjpd  )-vt  sin  {ppd  -  y/r  )p2  \ 


Subsystem  II: 

£  =  vgpe  COS (fjpd)~  k2£-vt  cos ifjpd  -  I//,.  )p 


Sub-system  I  depicts  the  system  dynamics  that  drive  the  UAV  such  that 
the  ground  speed  vector  vg  of  the  UAV  is  perpendicular  to  the  Line  of  Sight,  i.e. 

77=  0  and  pe  =  0  .  Thus  ensuring  the  stability  of  sub-system  I  guarantees  that  the 
UAV  orbits  above  the  target,  as  illustrated  in  Figure  1 . 


1  The  derivation  of  the  control  system  equations  is  given  from  equation  (3)  and  equation  (4) 

in  Reference  5. 
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B.  LYAPUNOV  STABILITY  ANALYSIS 


1 .  Stability  Analysis  for  Stationary  Target 


From  equation  (3),  it  is  obvious  that  sub-system  I  is  a  highly  non-linear 
system.  The  Lyapunov  function  for  the  non-linear  system  may  be  derived  from 
the  linearization  of  Sub-system  I.  Using  Taylor  Expansion,  the  linearized  model 
is: 


-k\ 


x  = 


x  =  A0x 


0 


(5) 


Solving  for  P  from  the  algebraic  Lyapunov  Stability  criterion2, 


P  = 


1 


K 

Pd 


_Pd_ 

1VS 

2kyg 


(6) 


A  candidate  Lyapunov  function  [6]  is  given  by  V  =  xTPx . 
Re-expressing  Subsystem  I  in  terms  of  the  linearized  model, 
x  =  A0x  +  kf(x)  where  A f(x)=f(x)-A0x  (7) 

By  substituting  equation  (7)  into  V  and  taking  time  derivative, 

V  (x)  =  -xT  x  +  2  AfT  (x)Px 
By  substituting  equation  (3)  into  A/(x)  yields: 


A/(x)  = 


,Pe  (l  -  COS (flPd))lpd  +  V,PcMm,  -  Vr)!pd 

v  p2  sin (tjpd )-  v,  sin (ppd  -y/r)p2  -  —  7 

Pd 


(8) 


2  Algebraic  Lyapunov  Stability  Criterion  is  given  by  AToP  +  PA0  =  -I 
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Define  a  compact  set  Qc 


<f :  f  ?£  <  cJ ;  c  =  4  ,n  (/>)  for  0  <  c„  <  1 

Pd 


From  matrix  property,  Amin  (P)||x||2  <  xTPx  <  Amax  (P)IMf 


The  target  is  assumed  to  be  stationary  (v,  =  o), 


Using  small  angle  approximation  and  equation  (9), 


(10) 

(11) 

(12) 

(13) 


Substituting  equation  (13)  &  (12)  into  (11)  and  after  simplification, 
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Substituting  equation  (15)  into  V(x ) 

V(x) <  -xTx  +  2 1 Af(x }\\\P\\ ||x|| 

V(x)<-  l-2r^j||P||  ||x||2  (16) 


From  the  Lyapunov  Stability  Criterion,  F(x)<0onlyif  ||^||<-^— 

2/vg 


'•4a  ,W< 


Pd 

2 


(17) 


2.  Stability  Analysis  for  Moving  Target 

The  stability  of  Subsystem  I  for  a  moving  target  can  be  analyzed  in  an 
approach  similar  to  that  of  a  stationary  target.  For  most  ground  moving  targets,  it 
can  be  reasonably  assumed  that  the  target  speed  is  bounded  such  that  the  least 
upper  bound  of  target  velocity  is  lower  than  v,  max . 

Re-arranging  equation  (8), 

’</))/ ' Pd 

vs  » 

~—v 

Pd 

Substituting  equation  (15)  into  equation  (18), 


V,/? cos (///?,  -  Yr)/pd 

-vtsm(r)pd-y/,  )p2  _ 


¥(x)= 


vKPe  (J  -  cos(?7y 
vgp2  sin (f]pd) 
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(\’rpcos(i]Pd  -  if/,')] 


Pd 


+  (v[sin(ffpd-ipr)p2j 


Since  cos(f/pd  -  y/^  <  1  and  sin (ijpd  -  y/r^<  1 


fO 


fv,) 


x )  <  y  -M  \\x\\  +  P  ,  — 


./v  \ypd 


i  V,  I  /  v 

U  +  (v'} 


-  r  i + <0 

From  equation  (9),  p  <  - - 

y  pd  ) 


^  r  v  v  r  i + o 

■XJ|SrUJw+v'-l"^ 


2—2 


1  +  /v? 


f  v  v  f  i+o 

*1  ^  —  F  +  T 


Pd 


t,  max 


l- 


Pd 


l  +  O  +  c-J 


(19) 


Substituting  equation  (19)  into  F(x) 


The  Lyapunov  stability  criteria  requires  v(x)<  0  for  asymptotic  stability. 
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From  stability  analysis  for  a  stationary  target  (Page  7),  Ibcll  <  — 

ypd 


CP 

> 

<N 

1 

p 

(20) 


Suppose  the  condition  given  by  equation  (20)  is  valid  for  all 

vt  :sup|^|<^max  ,  v„  e[v,Mliin,vgmax]  and  pd  e[pdmiD,pdmaii]  ,  Subsystem  1  is 

t>  0 

ultimately  bounded  for  any  x(o)aQc  .  Therefore  Qc  defines  the  region  of 
attraction  (RA )  for  subsystem  I  and  cp  is  a  measure  for  RA .  The  larger  the  region 
of  attraction  RA ,  the  larger  is  the  space  that  would  allow  a  SUAV  to  converge  to 
the  stable  solution. 


C.  DERIVING  OPTIMAL  GAIN  FROM  STABILITY  CRITERION 

Two  new  parameters  ex  and  e2  are  introduced  below  in  equation  (21)  and 
equation  (22)  to  determine  the  appropriate  values  of  gain  kx  for  both  stationary 
target  and  moving  target  cases.  From  the  previous  stability  analysis,  it  is  evident 
that  the  regions  where  ex  >  0  and  e2  >  0  are  the  regions  of  stability.  Figure  3  and 
Figure  4  illustrate  the  dependency  of  ex  on  kx  and  cp  for  known  UAV-Target 
kinematics 

2yvg 

2\max  (!  +  +  ^  +  11^1 

e1-cn - 

Pd-2yvg\\P\\ 


(21) 

(22) 
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Figure  3.  Stationary  Target  case,  e,  =  f(kl,cp )  for  vg  =  10  ,  pd  =  100 


Figure  4.  Stationary  Target  contour,  el  =  f(kx,cp )  for  vg  =  10  'Pd  ~  ioo 

One  observation  from  Figure  3  is  the  intersection  of  surface  e,  with  the 
plane  ex  »0,  within  the  stable  region  (ex  >0)  yields  an  optimal  choice  of  k,  that 
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maximizes  c  ,  i.e.,  maximizes  the  region  of  attraction^.  A  second  observation 
from  Figure  4  suggests  that  the  optimal  choice  of  kx  remains  unchanged  when 
the  surface  ex  intersects  with  any  plane  ex  =  constant.  From  both  observations,  it 
is  postulated  that  an  optimal  kx  exists  from  the  Lyapunov  stability  analysis. 
Successive  runs  of  ex  with  varying  speeds  of  UAV  further  confirm  the  existence 
of  optimal  kx. 

In  many  practical  military  missions,  foe  targets  more  consistently  keep 
maneuvering  or  evading  than  remaining  stationary.  An  optimal  feedback  gain  kx 
is  defined  by  analyzing  the  numerical  results  derived  from  the  Lyapunov  Stability 
Analysis  as  applied  to  the  moving  target  scenario.  The  optimality  of  the  feedback 
gain  is  defined  by  the  extension  RA .  Figure  5  and  Figure  6  below  illustrate  the 
dependency  of  e2  on  kx  and  cp  based  on  equation  (22)  for  known  UAV-Target 
kinematics.  The  e2  surface  figures  are  obtained  for  the  following  parameters: 
vg  =  10,  pd  =  100  and  vt  =  10. 


Figure  5.  Moving  Target  case,  e2  =  f(kx,cp )  for  vg  =  10  ,  vg  =  10  -A  =  100 
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Figure  6.  Moving  Target  contour,  e2  =  f(kvcp)  for  vg  =  10  ,  vt  =  10  ,pd  =  100 

Similar  to  the  stationary  target  case,  Figure  5  and  Figure  6  suggest  that 
optimal  kx  may  be  defined  from  the  Lyapunov  Stability  function  for  the  moving 
target  scenario.  From  Figure  5,  it  is  observed  that  e2  is  also  a  critical  parameter. 
The  optimal  kx  is  obtained  only  when  a  suitably  defined  e2  plane  intersects  with 
the  e2  surface.  Successive  runs  of  e2  with  varying  UAV  speed  and  target  speed 
in  Appendix  II  likewise  reinforced  the  existence  of  optimal  kx .  Hence  from  the 
Lyapunov  Stability  Analysis  for  the  control  law  implemented,  it  is  deduced  that  an 
optimal  kx  exists  that  maximizes  the  performance  of  the  control  law  by 
extending^  .  The  concept  of  Region  of  Attraction  RA  is  illustrated  in  Figure  7  on 
the  following  page.  From  the  kinematics,  it  is  shown  earlier  that  the  states  of  the 
system  are  given  by  range  error,  navigation  error  and  line-of-sight  error.  Once 
the  phase  trajectory  enters^,  the  state  of  the  dynamic  system  automatically 
converges  to  a  stable  solution.  From  a  system-stability  viewpoint,  larger  RA  is 
desired  so  that  the  stability  of  the  system  is  insensitive  to  disturbances. 
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It  is  evident  that  the  stable  solution  has  a  smaller  error  magnitude  for  the 
smaller^ .  The  larger  the^  ,  the  higher  the  likelihood  that  the  stabilized  solution 
will  be  displaced  much  further  from  the  origin.  Figure  8  below  depicts  the 
changes  in  the  region  of  attraction  with  increasing^.  The  increase  in  kx  drives 
the  reduction  in  the  size  of  RA . 


Figure  8.  Steady-State  T rajectory  showing  Region  of  Attraction 
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The  desired  phase  trajectory  first  selects  a  smaller  kx  so  that  the  phase 
trajectory  begins  converging  to  a  stabilized  solution  in  the  shortest  time.  Once  the 
phase  trajectory  begins  converging  to  a  stabilized  solution,  it  is  desirable  to 
increase  kx  to  drive  the  error  of  the  stabilized  solution  to  a  minimum.  Therefore 
the  optimal  kx  as  defined  by  the  Lyapunov  Stability  Analysis  seeks  the  optimal 
tradeoff  between  the  steady  state  error  and  speed  at  which  phase  trajectory 
arrives  at  RA .  The  dependency  of  optimal  kx  upon  vg,  vt,  and  pd  is  studied  in 

greater  detail  in  the  next  section  so  that  adjusted  gain  may  be  implemented  in  the 
control  law  for  the  SUAV. 

D.  DEPENDENCE  OF  OPTIMAL  GAIN  ON  TARGET  SPEED  vt 

Deriving  the  analytical  expression  for  optimal  kx  from  equation  (22)  is 
mathematically  complicated.  To  circumvent  the  mathematical  challenges,  the 
optimal  kx  is  established  by  computing  the  optimal  gain  as  target  speed  vt  varies. 
The  SUAV  speed  is  constant  at  10  m/s  at  a  desired  range  of  50m.  Figure  9 
shows  a  variation  of  surface  e2  as  target  speed  vt  increases  from  1  m/s  to  10 
m/s. 


0,2  0,3  04  05  O.S  0.7 

C 


Changes  in  Surface  e2  as  vt  increases 
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Figure  9. 


From  Figure  9,  it  is  observed  that  increments  in  target  speed  shift  the  e2 
surface  toward  higher  values  of  e2 .  A  fixed  plane  of  e2  is  thus  not  practicable 
because  the  intersection  of  the  fixed  plane  with  e2  surface  does  not  guarantee 
the  required  contour.  However  by  defining  the  intersecting  plane  e2  =  vt ,  desired 

contours  to  compute  optimal  kx  can  be  obtained  for  each  vt  .  The  effect  of 
increasing  target  speed  on  the  shape  of  e2  surface  is  more  obvious  from  the 
contour  plot  instead.  The  series  of  contours  is  depicted  in  Figure  10  below. 


Figure  10.  Contours  for  intersection  of  e2  plane  with  e2  surface 

From  the  contour  lines,  the  optimal  kx  at  different  vt  are  computed,  and 

the  dependency  of  optimal  kx  on  vt  is  plotted  in  Figure  1 1  below.  The  results 
obtained  show  that  optimal  kx  (where  cp  is  maximum)  is  independent  of  target 

velocity,  i.e.  optimal  kx=  f(vg,pd^\  only.  The  independence  relationship  between 

optimal  kx  and  vt  remains  valid  for  different  values  of  SUAV  speed  and  desired 
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distance.  Since  the  optimal  kx  for  each  target  speed  is  obtained  via  different 
values  for  the  e2  plane,  a  comparison  of  cp  for  each  optimal  kx  does  not  draw 
any  meaningful  conclusion. 

Optimal  k1  versus  Target  Speed 

0.6  | - T - T - 1 - T - ! - T - - - 1 - 1 
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Figure  1 1 .  Optimal  kx  versus  Target  Speed 

The  dynamics  of  subsystem  I  drive  the  UAV  to  orbit  around  the  target  at  a 
desired  distance.  From  the  control  law  implemented,  the  value  of  gain  kx  drives 
the  heading  of  the  UAV  to  achieve  its  desired  orbit.  Since  the  turn  rate  of  the 
UAV  is  limited  by  its  orbital  angular  momentum,  the  optimal  gain  kt  depends  on 
vg  and  pd  only. 

E.  DEPENDENCE  OF  OPTIMAL  GAIN  ON  vg  &  Pd 

A  similar  approach  is  undertaken  to  investigate  the  dependence  of  optimal 
gain  on  pd .  To  demonstrate  the  changes  in  e2  surface  as  pd  increases  from 
100m  to  500m,  the  SUAV  speed  is  maintained  at  10  m/s  and  the  target  speed  is 
kept  constant  at  5  m/s.  The  e2  surfaces  in  Figure  12  below  indicate  that  the  effect 
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of  increasing  pd  shifts  the  e2  surfaces  closed  towards  the  kx  axis  (lower  cp 
values  for  the  same  gain  kt ).  The  absence  of  vertical  shifts  for  the  e2  surfaces  in 
Figure  12  allows  a  fixed  level  of  e2  plane  to  intersect  with  changing  e2  surfaces. 
The  contour  plot  in  Figure  13  below  depicts  the  shape  change  in  e2  surface  due 
t°  Pd- 


o  o  at  aa  03  a  4  os  oe  o?  oe  o.» 


Figure  12.  Changes  in  e2  surfaces  as  pd  decreases 


Figure  13.  Contours  for  intersection  of  e2  plane  with  e2  surface 
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The  contour  plot  in  Figure  13  suggests  that  optimal  gain  decreases  as  pd 
increases.  From  kinematics,  a  larger  value  of  pd  is  expected  to  reduce  the  turn 
rate  expected  of  SUAV.  The  SUAV  thus  requires  a  smaller  rate  of  change  in 
bearing,  and  this  leads  to  a  smaller  value  for  optimal  gain.  A  similar  argument 
can  also  be  extended  for  the  relationship  between  the  optimal  gain  and  varying 

vg  for  a  constant  desired  ranges .  The  larger  the  SUAV  speed,  the  larger  the 

turn  rate  expected  from  the  SUAV  in  order  to  maintain  the  desired  range.  This 
SUAV  thus  requires  a  faster  rate  of  bearing  change,  and  this  leads  to  a  larger 
value  for  optimal  gain. 

For  implementation  of  the  proposed  adjustable  gain  control  law,  it  is 
assumed  that  the  SUAV  has  a  constant  operating  speed  of  10  m/s  to  50  m/s,  and 
the  desired  tactical  range  is  from  100m  to  500m.  The  optimal  gain  kx  for  the 
assumed  range  of  operating  conditions  is  tabulated  in  Table  1  below,  and  Figure 
14  illustrates  the  dependence  of  the  optimal  gain  on  SUAV  speed  and  desired 
range  to  target.  Henceforth  for  an  SUAV  operating  within  the  assumed  tactical 
operating  conditions,  an  adjusted  gain  control  law  can  be  implemented  in 
SIMULINK  model  and  HIL  simulations.  In  the  following  chapter,  the  performance 
of  the  adjustable  gain  control  law  is  evaluated  in  both  Simulink  model  testing  and 
hardware  simulation  testing. 


k  opt 

l 

pd 

V 

g 

100m 

150m 

200m 

250m 

300m 

350m 

400m 

450m 

500m 

10  m/s 

0.165 

0.115 

0.09 

0.075 

0.065 

0.055 

0.045 

0.035 

0.035 

20  m/s 

0.32 

0.215 

0.16 

0.13 

0.1050 

0.09 

0.08 

0.075 

0.065 

30  m/s 

0.42 

0.285 

0.21 

0.17 

0.14 

0.12 

0.105 

0.095 

0.085 

40  m/s 

0.55 

0.38 

0.285 

0.23 

0.19 

0.165 

0.145 

0.125 

0.115 

50  m/s 

0.73 

0.51 

0.38 

0.3050 

0.255 

0.215 

0.190 

0.17 

0.155 

Table  1 .  Optimal  Gain  for  Tactical  Operating  Condition  assumed 
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Dependency  nf  optimal  k1  on  v_  &  Rhad 


Figure  14.  Dependence  of  the  optimal  gain  on  vg  and  pd 
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III.  ADJUSTABLE  GAIN  IMPLEMENTATION 


A.  MODIFICATION  OF  SIMULINK  DIAGRAM  FOR  ADJUSTED  GAIN 


With  the  implementation  of  an  adjustable  gain  in  the  control  law  in 
equation  (1),  the  modified  control  law  is  given  by: 


¥  = 


— cos  77  - 
Pd 


vl,opt 


V 


(23) 


Yh  =  *l,opt7  +  k2£ 

Where  klopt=  f(vg,pd) 


The  control  system  architecture  as  depicted  in  Figure  15  below 
implements  the  control  law  given  by  equation  (23).  The  adjustable  gain  control 
law  is  implemented  within  the  VB  Control  block.  It  consists  of  an  autopilot  and  a 
gimbaled  camera  driven  by  the  control  inputs  y/  and  y/h .  The  onboard  camera 
provides  real-time  video  to  the  imagery  target-tracking  software.  This  software 
computes  the  tracking  error  s  when  the  target  is  engaged.  The  onboard  GPS 
and  inertial  navigation  systems  measure  the  navigation  error  77  for  the  SUAV. 
The  Control  System  Architecture  is  modeled  in  SIMULINK  to  predict  the  target¬ 
tracking  performance  of  the  SUAV  with  the  amended  control  law. 


v/ 

n 


Figure  15. 


Control  System  Architecture 
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B.  SIMULATION  RESULTS  FROM  SIMULINK  MODEL 


The  performance  and  the  system  response  to  the  newly  developed 
adjustable  gain  control  law  are  predicted  for  the  following  target  scenarios:  (1) 
stationary  target  scenario,  (2)  non-maneuvering  moving  target  scenario,  and  (3) 
maneuvering  target  scenario.  Since  the  system  response  of  most  control 
systems  can  be  modeled  either  as  a  first  order  or  a  second  order  system  [7],  two 
measures  of  performance  (MOP-1  and  MOP-2)  are  defined  as  follows: 

•  MOP-1  is  defined  as  the  percentage  of  maximum  steady-state 
range  deviation  as  compared  to  the  desired  range.  MOP-1  thus 
measures  the  SUAV  range-holding  capability  after  converging  to 
the  steady-state  flight  path.  This  is  similar  to  the  measurement  of 
performance  used  in  [5]. 

•  MOP-2  is  defined  as  the  convergence  speed,  computed  by  the  ratio 
of  desired  range  to  convergence  time.  Unlike  in  [5],  convergence 
time  is  defined  such  that  the  response  is  contained  within  MOP-1 . 
This  allows  MOP-2  to  be  a  well-defined  parameter  even  if  the 
response  is  similar  to  that  of  an  over-damped  second-order  system. 

1 .  Simulation  Results  for  Stationary  Target 

The  adjustable  gain  control  law  is  developed  from  the  Lyapunov  Stability 
Analysis  for  a  moving  target.  The  analysis  of  parameter  e2  in  Chapter  II  shows 
that  optimal  gain  is  independent  of  target  speed.  It  is  thus  deduced  that  the 
optimal  gain  in  Table  1  remains  valid  even  when  the  target  is  stationary.  For  the 
stationary  target  scenario,  simulations  are  conducted  to  achieve  the  following 
objectives: 
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•  To  investigate  the  system  response  of  the  adjustable  gain  in  control 
law 

•  To  investigate  the  performance  obtained  by  utilizing  the  adjustable 
gain  control  law  over  the  previous  control  law 

The  initial  conditions  for  this  simulation  run  are:  (1)  SUAV  velocity  =  28 
m/s,  (2)  SUAV  location  =  [0,  -1000,  300],  (3)  Target  location  =  [0,  0,  0],  (4) 
k2  =  0.25  and  (5)  pd  =  300  .  The  results  are  illustrated  in  Figure  16  on  the 
following  page. 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  pd  =  300  m  (286) 
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Range  Convergence 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Adjustable  Gain  versus  Time 
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Adaptive  Gain  versus  Time 


Figure  16.  SUAV  Performance  in  Tracking  Stationary  Target 

The  performance  of  the  adjustable  gain  control  law  for  this  simulation  run 
is  described  as  follows: 

a)  From  Figure  16b,  the  SUAV  converges  to  a  steady-state  range  of 
284m  from  the  stationary  target  and  the  steady-state  range  error  is 
16m.  MOP-1  is  evaluated  to  be  5.33%. 

b)  The  2%  settling  time  for  the  SUAV  range  is  measured  to  be  122 
seconds  from  Figure  16b.  Comparing  the  response  of  Figure  16b 
to  Figure  14c  and  Figure  16d,  all  three  figures  have  identical  values 
for  2%  settling  time.  MOP-2  is  thus  evaluated  to  be  4.098  m/s. 

c)  From  Figure  16c  and  16d,  it  is  evident  that  the  navigation  bearing 
error  and  gain  parameters  begin  to  converge  only  after  32  seconds. 
It  is  deduced  that  the  SUAV  take  32  seconds  to  arrive  at  the  region 
of  attraction  RA  and  the  convergence  time  within  RA  to  the  stable 

solution  is  approximately  90  seconds. 
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The  aim  of  the  first  simulation  run  is  to  investigate  the  improvement  in 
performance.  The  previous  simulation  is  repeated  with  the  same  set  of  initial 
conditions  with  a  different  constant  gain  ranging  from  ^  =  0.1  to  ^  =  0.4.  The 
improvement  in  performance  is  assessed  by  the  MOP-1  and  MOP-2  comparison 
obtained  for  each  case.  The  performance  obtained  for  each  case  is  appended  in 
Appendix  II  and  summarized  in  Table  2  below. 


Gain 

MOP-1 

MOP-2 

0.1 

6.67% 

3.62  m/s 

0.2 

5.68% 

2.18  m/s 

0.3 

19.3% 

1.72  m/s 

0.4 

32.0% 

1 .09  m/s 

Adjustable 

5.33% 

4.10  m/s 

Table  2.  Performance  Comparison  between  Adjustable  Gain  versus  Constant  Gain 


A  comparison  of  MOP-1  suggests  that  there  is  a  constant  gain  of  0.1  to 
0.3  that  reduces  the  steady-state  error  to  a  minimum.  However  as  the  gain 
increases  from  0.1  to  0.3,  a  comparison  of  MOP-2  shows  that  the  speed  of 
convergence  decreases.  Thus  from  the  performance  of  the  adjustable  gain 
control  law,  it  is  concluded  that  the  implementation  of  an  adjustable  gain  seeks 
the  optimal  balance  between  MOP-1  and  MOP-2,  i.e.  seeking  the  lowest  steady- 
state  range  error  while  optimizing  the  speed  of  convergence. 

2.  Simulation  Results  for  Non-Maneuvering  Target 

The  objectives  in  the  series  of  simulations  conducted  for  a  non¬ 
maneuvering  target  are  similar  to  that  of  the  stationary  target.  The  first  objective 
is  to  investigate  the  performance  of  the  adjustable  control  law  when  the  target  is 
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moving  in  a  constant  velocity.  For  the  stationary  target  scenario,  the  adjustable 
gain  gives  optimal  performance  by  the  optimal  tradeoff  between  MOP-1  and 
MOP-2.  The  second  objective  is,  therefore,  to  investigate  whether  optimized 
performance  of  an  adjustable  control  law  remains  valid  for  the  moving  target 
scenario.  The  parameters  for  the  series  of  simulations  conducted  are  identical  to 
the  stationary  target  scenario,  except  that  the  target  is  now  moving  in  an  easterly 
direction  with  a  speed  of  5  m/s.  The  initial  conditions  for  this  simulation  run  are: 
(1)  SUAV  velocity  =  28  m/s,  (2)  SUAV  location  =  [0,  -1000,  300],  (3)  Target 
location  =  [0,  0,  0],  (4)  k2  =0.25  and  (5)  pd  =  300.  (6)  Target  velocity  =  5  m/s. 
The  results  obtained  are  illustrated  in  Figure  17  on  the  following  page. 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  pd  =  300  m 
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Range  Convergence  Performance 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Adjustable  Gain  versus  Time 
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Adaptive  Gain  versus  Time 


Figure  17.  SUAV  Performance  in  Tracking  Non-maneuvering  Targets 

The  observations  of  the  simulated  SUAV  performance  for  tracking  a  non¬ 
maneuvering  target  are  summarized  as  follows: 

a)  Figure  17b  indicates  that  the  SUAV  range  does  not  converge  to  a 
fixed  value.  Instead  the  SUAV  range  continuously  oscillates  within 
bounds  as  suggested  by  the  results  of  the  Lyapunov  stability 
analysis. 

It  is  observed  that  the  steady  state  response  of  range  oscillates 
between  334.5  m  and  249.5  m,  and  the  mean  value  is  292  m.  The 
previous  performance  measure  for  MOP-1  is  an  inadequate 
measure  for  range  convergence.  For  a  moving  target,  an  alternative 
performance  measure  for  range  convergence  is  devised,  MOP-3. 
MOP-3  computes  the  percentage  error  between  the  desired  range 
and  the  mean  value  for  the  steady-state  function;  thus,  MOP-3  is 
calculated  to  be  2.67%. 
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b)  Likewise  the  convergence  time  defined  previously  is  not  applicable 
in  the  case  of  a  non-maneuvering  target.  Instead  of  utilizing  the  2% 
settling  time  as  a  measure,  the  convergence  time  is  re-defined  as 
the  time  taken  for  a  response  to  reach  steady  state  function.  From 
Figure  17b  the  convergence  time  is  140  seconds.  MOP-2  is  thus 
evaluated  to  be  3.57  m/s. 

c)  From  Figure  17c  and  Figure  17d,  the  SUAV  takes  31.2  seconds  to 
be  within  the  region  of  attraction  RA  (as  shown  in  Figure  15). 
Likewise,  the  convergence  time  within  RA  is  dependent  upon  the 
initial  position  of  the  SUAV  from  the  target.  It  is  also  observed  that 
the  steady  state  response  for  feedback  gain  is  an  oscillatory 
waveform  instead  of  a  fixed  value. 

d)  Since  the  steady  state  response  for  range  error  and  navigation 
oscillates  within  bounds,  the  region  of  attraction  can  be  estimated 
from  the  magnitude  of  the  bounds,  as  shown  in  Figure  17c  and 
Figure  17d. 

In  the  second  series  of  simulation  runs,  the  aim  is  to  investigate  the 
improvement  in  performance  of  the  adjustable  gain  control  law  over  the  constant 
gain  control  law  for  non-maneuvering  targets.  The  initial  conditions  for  this 
simulation  run  are:  (1)  SUAV  velocity  =  28  m/s,  (2)  SUAV  location  =  [0,  -1000, 
300],  (3)  Target  location  =  [0,  0,  0],  (4)  k2=0.25  and  (5)/>rf  =  300.  (6)  Target 
velocity  =  5  m/s.  The  previous  simulation  is  repeated  with  different  constant  gains 
ranging  from  kx  =  0.05  to  kx  =  0.4 .  The  performance  obtained  for  each  case  is 
appended  in  Appendix  III  and  summarized  in  Table  3  below. 
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Gain 

MOP-3 

MOP-2 

0.05 

9.00% 

1 .97  m/s 

0.1 

4.50% 

3.03  m/s 

0.2 

6.27% 

2.66  m/s 

0.3 

20.32% 

2.18  m/s 

0.4 

32.92% 

1 .37  m/s 

Adjustable 

2.67% 

3.57  m/s 

Table  3.  Performance  comparison  for  Non-maneuvering  Target  at  5m/s 

A  comparison  of  MOP-3  in  Table  3  suggests  gain  0.1,  reducing  the 
steady-state  error  to  a  minimum.  The  same  value  of  kx  also  increases  the 
convergence  speed  to  maximum  and  gain  ^  =  0.1  appears  to  be  the  optimum 
gain.  However,  it  is  evident  that  the  adjusted  gain  shows  a  much  improved 
performance  over  the  constant  gain  control  law.  Therefore,  optimized 
performance  for  the  adjustable  gain  control  law  remains  valid  for  a  constant 
speed  non-maneuvering  target  scenario. 

Previously  in  5,  it  has  been  demonstrated  that  for  the  constant  gain  control 
law,  SUAV  target-tracking  performance  degrades,  i.e.  an  increase  in  range  error 
and  a  decrease  in  convergence  speed  is  created.  This  motivates  the  need  for  a 
more  rigorous  analysis  to  determine  the  sensitivity  of  an  adjustable  gain  control 
to  target  speed.  The  simulation  is  repeated  with  target  speeds  varying  from  5  m/s 
to  20  m/s;  the  performance  for  each  target  speed  is  appended  in  Appendix  III. 
The  initial  conditions  are:  (1)  SUAV  velocity  =  28  m/s,  (2)  SUAV  location  =  [0,  - 
1000,  300],  (3)  Target  location  =  [0,  0,  0],  (4)  k2  =0.25  and  (5)  pd  =  300.  The 
sensitivity  of  the  adjustable  gain  control  law  to  target  speed  is  summarized  in 
Table  4. 
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Target  Speed 

MOP-3 

MOP-2 

20  m/s 

18.80% 

5.00  m/s 

15  m/s 

9.8% 

5.35  m/s 

10  m/s 

3.00% 

3.45  m/s 

5  m/s 

2.67% 

3.57  m/s 

Table  4.  Performance  comparison  for  varying  Target  Speed 


As  observed  from  Table  4,  an  increase  in  target  speed  leads  to 
degradation  in  the  range  holding  for  the  adjusted  gain  control  law.  The  closer  the 
target  speed  approaches  the  SUAV  speed,  the  more  severe  the  degradation  in 
range  holding  becomes.  This  may  be  noted  by  the  comparison  of  MOP-3. 
Intuitively  the  sudden  increase  in  MOP-2  for  target  speed  at  15  m/s  is  due  to  the 
larger  range  error.  The  larger  the  range  error,  the  larger  the  SUAV  orbit  radius  is 
expected  to  become,  resulting  in  a  faster  convergence  speed. 

The  conclusion  derived  from  the  series  of  simulations  conducted  for  non¬ 
maneuvering  targets  include: 

a)  The  adjustable  gain  control  law  improves  performance  as 
compared  to  the  constant  gain  control  law.  The  use  of  the 
adjustable  gain  in  the  control  law  optimizes  range  convergence 
performance  and  convergence  speed. 

b)  Range-holding  performance  degrades  with  increased  target  speed. 
As  target  speed  approaches  the  SUAV  speed,  the  more  severe  the 
degradation  in  range  holding  performance.  However,  convergence 
speed  improves  with  target  speed  increase. 
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3. 


Simulation  Result  for  Maneuvering  Target 


The  initial  conditions  for  this  simulation  run  are:  (1)  SUAV  velocity  =  28 
m/s,  (2)  SUAV  location  =  [0,  -1000,  300],  (3)  Target  location  =  [0,  0,  0],  (4) 
k2  =  0.25  and  (5)  pd  =  300 .  (6)  Target  velocity  =  10  m/s. 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 
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(b)  Range  Convergence  Performance,  pd  =  300  m 
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Range  Convergence  Performance 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Adjustable  Gain  versus  Time 
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Adaptive  Gain  versus  Time 


Figure  18.  SUAV  Performance  in  Tracking  Maneuvering  Target 

In  Figure  18b,  the  measure  of  performance  for  the  maneuvering  targets 
are  given  by  (1)  MOP-3  =  24.28  %  and  (2)  MOP-2  =  3.81  m/s.  In  comparing  the 
results  obtained  in  Table  4,  it  is  evident  that  when  a  target  changes  its  course  of 
direction,  the  range  holding  capability  of  the  SUAV  deteriorates  significantly.  The 
navigation  error  77  is  much  larger  compared  to  that  of  a  non-maneuvering  target, 
and  speed  of  convergence  is  reduced  significantly.  However  the  SUAV  continues 
to  track  the  target,  as  shown  by  the  SUAV  trajectory  in  Figure  18a,  with  a  larger 
region  of  attraction.  Hence  it  is  concluded  that  the  adjustable  gain  control  law  as 
proposed  in  equation  (23)  is  capable  of  tracking  a  maneuvering  target. 

C.  HARDWARE-IN-LOOP  SIMULATION 

The  intention  of  HIL  simulation  is  to  validate  the  performance  improvement 
concluded  previously  from  the  SIMULINK  model.  The  simulated  SUAV  model 
has  demonstrated  improved  performance  by  the  adjustable  gain  control  law  in 
equation  (23)  over  the  previous  control  law.  In  practical  implementation  of  an 
SUAV  collaborating  with  the  UGV,  the  SUAV  actual  response  differs  from  the 
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SIMULINK  model  of  the  SUAV.  Hardware-1  n-The-Loop  (HIL)  simulation  has  been 
carried  out  to  ensure  the  robustness  of  the  modified  control  law.  The  SUAV  used 
for  the  HIL  simulation  is  the  Senior  Telemaster  SUAV  shown  in  Figure  19  below. 
The  HIL  setup  and  the  results  obtained  are  described  in  a  later  part  of  this 
section. 


Figure  19.  Senior  Telemaster  SUAV  [From  4] 

1.  Hardware-In-Loop  Setup 

Cloud  Cap  Technology  has  developed  an  integrated  avionics  system 
control  (Piccolo)  for  small-unmanned  aircraft  that  allow  HIL  testing  of  SUAV 
performance.  Piccolo  consists  mainly  of  four  parts:  an  avionics  control  system 
onboard  SUAV,  a  Ground  Control  Station  (GCS),  a  PC  for  manned  operations, 
and  manual  flight  control  via  a  modified  Futaba  radio  controller.  The  HIL 
hardware  setup  is  identical  to  that  performed  in  5.  The  HIL  setup  in  the  SUAV  is 
depicted  in  Figure  20  below: 
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Computer  $2 


Computer  Computer  r  1 


Figure  20.  Schematic  of  HIL  Setup  [From  5] 

The  Piccolo  system  has  several  control  loops.  The  slower  outer  loop 
computes  the  desired  turn  rate  reference  command  for  circular  guidance  and 
sends  the  command  turn  rate  to  the  faster  inner  loop.  The  faster  inner  loop  then 
controls  the  actuators  so  as  to  follow  the  reference  commands  and  therefore 
maintain  stable  dynamics  of  the  aircraft.  In  the  HIL  setup  and  simulation 
environment,  the  autopilot  is  connected  to  the  second  computer  via  the  USB- 
CAN  data  exchange  cable.  The  simulator,  which  runs  in  the  second  computer, 
tests  the  aircraft  control  laws  in  a  software  environment  with  the  servo  and 
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sensor  data  which  is  received  from  the  CAN  bus.  Since  the  simulator 
communicates  with  the  avionics  in  real  time,  the  second  computer  is  isolated  for 
simulator  software  only.  The  GCS  is  of  similar  hardware  configuration  as  the 
avionics  system  onboard  the  SUAV.  The  GCS  manages  the  communication  link 
to  the  avionics  system  to  interface  with  the  autopilot  in  the  loop  console.  It  also 
provides  a  command  and  control  stream  to  the  operator’s  PC  via  a  standard 
ninepin  serial  cable.  The  third  computer  runs  the  Flight  Gear  application  that 
provides  visualization  of  the  effect  of  the  control  law  on  flight  performance  and 
stability  of  the  aircraft.  More  detailed  information  regarding  the  HIL  setup  may  be 
obtained  from  Ref  5,  Ref  8,  Ref  9  and  Ref  10. 

By  employing  an  XPC  Target  within  the  SIMULINK  Real-Time  Workshop 
(RTW)  environment,  HIL  simulation  may  be  executed  by  the  PC-104  board 
onboard  the  SUAV.  The  simulation  model  in  SIMULINK  is  compiled  on  the  Host 
PC  into  ‘C’  code  that  runs  on  the  Target  PC.  The  real-time  capability  of  the 
system  executes  the  code  at  a  regular  interval  for  optimal  control.  From  the 
previous  SIMULINK  model,  the  AP  controller  block  and  the  6-DOF  aircraft  model 
block  are  replaced  with  the  actual  Piccolo  AP  controller  hardware.  The  simulator 
software  provides  the  sensor  input  that  is  required  to  compute  the  simulated  flight 
parameters  of  the  aircraft.  The  SIMULINK  model  schematic  for  the  XPC  Target 
model  is  identical  to  that  in  Tay’s  work  except  for  the  gain  input  to  the  control  law. 
The  SIMULINK  model  schematic  for  the  HIL  simulation  is  depicted  in  Figure  21 
on  the  following  page.  The  procedure  for  running  the  XPC  HIL  simulation  is 
documented  in  Appendix  V. 
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Figure  21 .  XPC  Target  Model  Schematic 


41 


2. 


HIL  Simulation  Results 


The  objectives  in  the  series  of  simulations  that  were  conducted  for  a 
stationary  target  are  identical  to  those  performed  for  the  SIMULINK  model  of  the 
SUAV.  The  first  objective  is  to  investigate  if  implementation  of  the  adjustable  gain 
control  law  in  physical  hardware  offers  improved  performance  over  the  constant 
gain  control  law.  The  first  series  of  simulations  repeats  the  HIL  simulation  with  a 
different  constant  gain,  ranging  from  kx  =  0.05  to  kx  =  0.4  for  the  adjustable  gain 
case.  The  second  objective  is  to  investigate  the  sensitivity  of  the  adjustable  gain 
control  law  to  target  speed.  In  the  second  series  of  HIL  simulations,  target 
velocity  varies  from  5  m/s  to  20  m/s.  The  initial  conditions  for  this  simulation  run 
are:  (1)  SUAV  velocity  =  28  m/s,  (2)  SUAV  location  =  [0,  -1000,  500],  (3)  Target 
location  =  [0,  0,  0],  (4)  k2  =  0.25  and  (5)  pd  =  300 .  Figure  22  below  shows  the 
HIL  simulation  result  obtained  for  stationary  target  scenario. 


(a)  SUAV  &  Target  Trajectory 
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(b)  Range  Convergence  Performance,  Pd  =  300 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 
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(d)  Adjustable  Gain  versus  Time 


Figure  22.  SUAV  HIL  Performance  in  Tracking  Stationary  Target 

Unlike  the  SIMULINK  model,  the  trajectory  of  an  SUAV  does  not  converge 
to  a  fixed  range  from  the  target.  However  the  response  of  the  HIL  simulation  is 
similar  to  that  obtained  for  maneuvering  targets  where  steady-state  responses  of 
the  SUAV  are  within  bounds.  Through  comparisons  of  Figure  20b  to  Figure  14b, 
it  is  evident  that  the  HIL  simulation  introduces  more  disturbances  to  the  steady- 
state  response.  This  is  because  the  SIMULINK  model  in  simulation  does  not 
reflect  the  actual  hardware  response.  Instead  the  SIMULINK  model  is  an 
approximation  to  the  behavior  of  the  actual  hardware.  A  similar  response  to  the 
adjustable  gain  control  law  is  expected.  As  such,  MOP-3  is  a  more  suitable 
performance  measure  than  the  MOP-1  is.  Similarly  MOP-2  defined  for  moving 
targets  is  used  as  the  performance  measure  for  speed  of  convergence.  MOP-3  is 
measured  to  be  -  8.01  m,  and  MOP-2  is  measured  to  be  3.71  m/s.  The 
performance  of  constant  gain  control  law  in  HIL  simulations  are  appended  in 
Appendix  IV  and  summarized  in  Table  5  on  the  following  page. 
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Gain 

MOP-3 

MOP-2 

0.05 

4.68% 

1 .44  m/s 

0.1 

2.95% 

3.53  m/s 

0.2 

4.62% 

3.13  m/s 

0.3 

1 1 .87% 

2.56  m/s 

0.4 

16.12% 

2.41  m/s 

Adjustable 

2.67% 

3.71  m/s 

Table  5.  HIL  Performance  comparison  for  Stationary  Target 

Although  the  HIL  simulation  outcome  varies  significantly  from  the 
SIMULINK  model,  the  flight  characteristics  and  control  law  behavior  are  identical 
to  that  of  the  SIMULINK  model.  Similar  to  the  SIMULINK,  Table  5  suggests  that 
at  gain  kx  =0.1  the  average  steady  state  range  error  is  at  its  minimum.  For  the 
same  value  of  kx  convergence  speed  is  at  its  maximum,  and  gain  kx  =  0.1 
appears  to  be  the  optimum  gain  for  the  constant  gain  control  law.  However  Table 
5  also  demonstrates  that  the  adjustable  gain  control  law  has  improved 
performance  over  the  constant  gain  control  law.  Hence  from  the  first  series  of  HIL 
simulations,  optimal  performance  for  the  adjustable  gain  control  law  is  validated 
in  an  HIL  Simulation  environment. 


Target  Speed 

MOP-3 

MOP-2 

20  m/s 

48.67% 

6.96  m/s 

15  m/s 

22.86% 

6.13  m/s 

10  m/s 

8.63% 

4.23  m/s 

5  m/s 

1 .36% 

6.38  m/s 

Table  6.  HIL  Performance  comparison  for  Non-Maneuvering  Target  Speed 
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Table  6  validates  the  previous  SIMULINK  hypothesis  that  the  increase  in 
target  speed  leads  to  degradation  in  the  range  holding  for  the  adjustable  gain 
control  law.  The  closer  the  target  speed  approaches  the  SUAV  speed,  the  more 
severe  the  degradation  in  range  holding  becomes.  This  may  be  noted  by  the 
comparison  of  the  MOP-3.  Similar  to  the  results  for  the  SIMULINK  model,  the 
larger  SUAV  orbit  radius  is  expected  for  larger  range  error  and  thus  faster 
convergence  speeds.  Since  the  results  from  the  SIMULINK  model  simulation 
and  the  XPC  Target  simulation  are  identical,  the  improved  performance  for 
adjustable  gain  control  law  has  been  verified. 
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IV.  CONCLUSION  AND  RECOMMENDATIONS 


In  comparison  with  the  constant  gain  control  law  as  defined  by  equation 
(1),  the  newly  modified  control  law  selects  an  optimal  gain  by  taking  the  desired 
range  and  SUAV  speed.  The  condition  for  optimal  gain  is  derived  from  the 
Lyapunov  Stability  analysis,  based  on  the  kinematics  of  target  tracking,  thus 
ensuring  the  robustness  of  the  control  system.  The  performance  improvement 
provided  by  the  adjustable  gain  control  law  developed  in  equation  (23)  seeks  the 
optimal  tradeoff  between  speed  of  convergence  and  range  holding  capability. 

The  results  obtained  from  the  implementation  of  the  adjustable  gain 
control  law  in  both  software  simulation  and  Hardware-In-Loop  simulations 
showed  identical  improvement  in  performance  over  the  previous  control  law. 

Recommendations  for  future  research: 

a)  Since  the  modified  control  law  offers  improved  performance  without 
incurring  hardware  costs,  it  is  recommended  that  actual  flight  trials 
should  be  conducted  to  test  the  robustness  of  performance  gain 
where  the  SUAV  is  subjected  to  unwanted  aerodynamic 
disturbances  in  a  practical  environment. 

b)  It  is  also  recommended  that  future  work  should  seek  further 
refinement  of  the  control  law,  particularly  the  dependence  on 
continuous  varying  target  speed  and  direction. 
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APPENDIX  I 


Figure  23.  SIMULINK  MODEL 
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Figure  24.  XPC  HIL  MODEL 
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APPENDIX  II:  STATIONARY  TARGET  TRACKING 


Stationary  Target  Tracking:  Case  2:  kx  =  0.1 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  pd  =  300  m,  (280m  138sec) 


Range  Convergence 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  25.  SUAV  Target  Tracking  Performance  with  Gain  kx  =  0.1 

Stationary  Target  Tracking  Case  3:  A,  =  0.2 

(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 
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(b)  Range  Convergence  Performance,  pd  =  300  m  (229s,  317m) 


Range  Convergence 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  26.  SUAV  Target  Tracking  Performance  with  Gain  kx  =  0.2 
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Stationary  Target  Tracking  Case  4:  kx  =  0.3 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  pd  =  300  m  (291s,  358m) 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  27.  SUAV  Target  Tracking  Performance  with  Gain  kx  =  0.3 

Stationary  Target  Tracking  Case  5:  kx  =  0.4 

(a)  SUAV  &  Target  Trajectory  (460s,  396m) 


SUAV  &  Target  Trajectory 
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(b)  Range  Convergence  Performance,  pd  =  300  m 


Range  Convergence  Performance 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 
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Figure  28.  SUAV  Target  Tracking  Performance  with  Gain  kx  =  0.4 
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APPENDIX  III:  NON-MANEUVERING  TARGET  TRACKING 


Performance  Benchmark  Case  1 :  kx  =  0.4 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  T rajectory 


(b)  Range  Convergence  Performance,  pd  =  300  m,  (280m  138sec) 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 
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Figure  29.  Non-Maneuvering  Target  Tracking  Performance  with  Gain  kx  =  0.4 


Performance  Benchmark  Case  2:  A,  =  0.3 


(a)  SUAV  &  Target  Trajectory 


SUAV  Si  Target  Trajectory 
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(b)  Range  Convergence  Performance,  pd  =  300  m 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 
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Figure  30.  Non-Maneuvering  Target  Tracking  Performance  with  Gain  kx  =  0.3 
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Performance  Benchmark  Case  3:  kx  =  0.2 


(a)  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pa  =  300 


Range  Convergence  Performance 


Figure  31 .  Non-Maneuvering  Target  Tracking  Performance  with  Gain  kx  =  0.2 
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Performance  Benchmark  Case  4:  kx  =  0.1 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  32.  Non-Maneuvering  Target  Tracking  Performance  with  Gain  kx  =  0.1 

Performance  Benchmark  Case  4:  k]  =  0.05 

(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 
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(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  33.  Non-Maneuvering  Target  Tracking  Performance  with  Gain  k]  =  0.05 
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Target  Speed  Sensitivity  Case  1 :  vt  =  10  m/s 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pa  =  300 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Adjustable  Gain  versus  Time 


Adaptive  Gain  versus  Time 


Figure  34.  Adjustable  Gain  Control  Law  Performance  vt  =  10  m/s 
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Target  Speed  Sensitivity  Case  2:  v,  =  1 5  m/s 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Adjustable  Gain  versus  Time 


Adaptive  Gain  versus  Time 


Figure  35.  Adjustable  Gain  Control  Law  Performance  vt  =  10  m/s 
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Target  Speed  Sensitivity  Case  2:  vt  =20  m/s 


(a)  SUAV  &  Target  Trajectory 


SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  pd  =  300  (18.80%) 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Adjustable  Gain  versus  Time 


Adaptive  Gain  versus  Time 


Figure  36.  Adjustable  Gain  Control  Law  Performance  vt  =  20  m/s 
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APPENDIX  IV  HIL  SIMULATION  RESULTS 


Stationary  Target  Case  1 :  kx  =  0.1 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pa  =  300 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  37.  Constant  Gain  Control  Law  HIL  Performance  k{  =  0.1 

Stationary  Target  Case  2:  kx  =  0.2 

(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 
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(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 


Time  (sec) 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  38.  Constant  Gain  Control  Law  HIL  Performance  kx  =  0.2 
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Stationary  Target  Case  3:  A,  =  0.3 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  pd  =  300 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  39.  Constant  Gain  Control  Law  HIL  Performance  kx  =  0.3 

Stationary  Target  Case  4:  kx  =  0.4 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  T rajectory 
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(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 


Time  (sec) 


(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


Figure  40.  Constant  Gain  Control  Law  HIL  Performance  kx  =  0.4 
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Stationary  Target  Case  5:  A,  =  0.05 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pd  =  300 


Hange  uonvergence  Henormance 
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(c)  Navigation  Error  Performance,  Pd  =  300 


Navigation  bearing  angle  convergence  performance 
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Non-maneuvering  Target  Case  1:  vt  =  5 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Gain  versus  Time 


Gain  Versus  Time 


Figure  41 .  HIL  Performance  for  Non-maneuvering  Target,  vt  =  5 
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Non-maneuvering  Target  Case  2:  vt  =  10 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


East  (m) 


(b)  Range  Convergence  Performance,  Pd  =  300 


Hange  uonvergence  Keriormance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Gain  versus  Time 


Gain  Versus  Time 


Figure  42.  HIL  Performance  for  Non-maneuvering  Target,  vt  =  10 
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Non-maneuvering  Target  Case  3:  vt  =  15 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pd  =  300 


Range  Convergence  Performance 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Gain  versus  Time 


Gain  Versus  Time 


0. 138  - 


0137 


CO  0  136 

o 


0. 135  - 


0. 134  - 


0.133 


I  ^ 


J i_ I  j 


J_ i_ i  l 


0  100  200  300  4DQ  500  600  700  800  900  1000 

Time  (sec) 


Figure  43.  HIL  Performance  for  Non-maneuvering  Target,  vt  =  15 
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Non-maneuvering  Target  Case  4:  vt  =  20 


(a)  SUAV  &  Target  Trajectory 


HIL:  SUAV  &  Target  Trajectory 


(b)  Range  Convergence  Performance,  Pd  =  300 
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(c)  Navigation  bearing  error  Convergence  Performance 


Navigation  bearing  angle  convergence  performance 


(d)  Gain  versus  Time 

uain  versus  i  ime 


Figure  44.  HIL  Performance  for  Non-maneuvering  Target,  vt  =  20 
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APPENDIX  V.  PROCEDURES  FOR  HIL  SIMULATION 


Order 

Procedure 

1 

Set  up  hardware  as  described  in  Chapter  III 

2 

Run  Piccolo  Simulator  software  on  computer  #2.  Under  the  ‘file’  tab, 

choose  ‘open  aircraft’.  Select  Cub.txt  from  the  folder  ‘Cub  Model’.  Under 

‘file’  tab,  choose  ‘load  state’  option.  Select  initial  state  desired. 

3 

On  Operator  PC,  run  the  Piccolo  Operator  Software.  Using  the  Futaba 

controller,  attempt  to  achieve  trim  flight  using  manual  mode.  Once  trim 

flight  is  achieved,  capture  trim  flight  on  the  Piccolo  Operator  software 

and  click  ‘send’.  Switch  to  autopilot  mode  on  the  Futaba  controller. 

4 

From  the  Piccolo  Operator  Software,  design  a  initial  flight  plan  for  the 

SUAV.  The  Cartesian  coordinates  of  target  and  SUAV  location  are  given 

in  NEU  coordinates  with  respect  to  the  ground  station.  The  inputs  to  the 

Operator  Software  have  to  be  given  in  longitude,  latitude  and  altitude. 

SIMULINK  model  in  Appendix  1  converts  from  the  desired  longitude, 

latitude  and  altitude  to  NEU  coordinates. 

5 

From  the  initial  location  and  initial  velocity  in  NEU  coordinates,  a  3-point 

flight  plan  can  be  designed.  From  the  direction  of  the  velocity,  choose  a 

starting  point  A  in  NEU  such  that  vector  pointing  from  A  to  the  initial 

location  is  in  the  direction  of  the  velocity.  The  XPC  SIMULINK  model 

sets  the  initial  location  as  the  final  point  of  the  of  the  flight  plan.  When 

editing  the  flight  plan,  allow  the  SUAV  to  pass  through  initial  location  i.e. 

without  pre-turn.  This  can  be  done  by  selecting  the  ‘MAP’  tab  on  the 

operator  software  and  followed  by  ‘Edit’  tab. 

6 

XPC  SIMULINK  model  in  Appendix  1  is  the  HIL  simulation  interfacing  the 

operator  PC  and  SUAV.  This  model  also  consist  of  the  algorithm  loaded 

onboard  SUAV  executing  the  variable  gain  control  law 
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Order 

Procedure 

7 

Start  MATLAB  7.1.  Load  both  XPC  model  and  the  GUI  model  in 

MATLAB  environment.  The  GUI  model  for  trajectory  display  is  shown  by 

SIMULINK  model. 

8 

To  run  the  XPC  model,  firstly  Crtl+D,  followed  by  Ctrl+B.  This  compiles 

and  upload  the  real-time  code  onto  the  PC-104  onboard  the  SUAV. 

Select  “External”  and  click  on  “Connect  to  Target”  icon. 

9 

To  initiate  the  HIL  simulation  at  a  desired  point  of  the  preset  flight  plan, 

10 

Click  ‘run’  icon  on  the  XPC  model  followed  by  ‘run’  icon  on  the 
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